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(57)Abstract: 

PURPOSE: To control a cleaning robot so that it is 
traveled accurately up to an object point along a wall 
face without being deviated from a normal track. 
CONSTITUTION: This controller is provided with an 
obstacle sensing means 3 that senses the presence of an 
obstacle and the distance up to the obstacle with a 
navigation sensor when the cleaning robot runs on a wall 
face, a drive state sensing means that uses a navigation 
sensor and an ultrasonic wave sensor to sense a distance 
of the cleaning robot from the wall face and the drive 
angle when the obstacle sensing means 3 indicates the 
absence of the obstacle, and a drive control means that 
adjusts a force of left right side power wheels by the 
parting distance and the drive angle sensed by the drive 
state sensing means so that the cleaning robot is driven 
on a normal track along the wall face. 
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d^fiffiw** e>gf^«aesr«^i-5 x *> w&smmk 2 0 

4»fe*H*— tmhUz 2 Kfflpffi-g-SrW^j-fS. 
[0 0 6 7] rivKiO, BtrE^fflJ-e-^^iijgiss 2-e 

*tr*-^3 4SrBIb$*5rtKJ:9, *ffi!lli)^$|3 

[0 0 6 8] d©i5K, alTEfe*ffi!l«)^«r3 5, 3 6 
©KftK X 9n#y h jf|»tt 1 * s SSW*^9f^E)!ISr 
fiM#-f5J:5K*St, ^fyT'S 1 4-Cf4S5E^7 1 y 
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[0 0 6 9] UtrfS^rs' 7*S 1 4 -e^JS'J^^ 
gA#0 (SO i9*t?ftV^ (NO©it) iCtt, 

^ftSAaso x o /jN-efcsa^JB'Ji-s., 

[0 0 7 0] MJlB^XyT'S 1 5-CtfWJ*t*x *ffA 
SAtf 0 i *) /J>©#& (YES©tf) Kltt, MJfBna)? 
y H»»«l^Ki««-*rtll!:*1TU-CV^««"C*)5fc 
ft, X?y?S 1 6-ei*IWBW»*ft2 OttnaKy bit 
1 #*BiWlc»o"C*oa[ <*k:itff "C# 5 <k 5 £W 

3 1 icuMMMfrfcttiai" 
[0071] LfcdJox, mefen*— ^w»»3 i-e 

[0 0 7 2] MJIB^s/ys 1 4-COWM1*** 

fiia»JW¥S: 2 o K i 9 *0»J $ *i.fc*fTA a A # 0 J: •> 
(YESfct) KttiMEn#y h»gfc8U:&SB* 
tf#rRjlCj£*TLTV>5ttffi-e*>5fcft, ^*^S17 

TfcoKCfciffre* 3 J: 3*fll*— y"WW*3 2 idM 

[0 0 7 3] r»iKJ:9, «nE*|g*-*W&»3 2"C 

[0 0 7 4] rOi5JC. f$im££WW)Jjft3 5, 3 6 

WKDUci (3 njjfy HM«|i*miBWK:»o-C*o« 

[0 0 7 5] Mlia^'ryT'S 1 8 -eroWJifc*. naKy 

t) lift, «W^y^S3lc*»U-C^yyys 3£1 

l^TLfeS^ (YESratt) |Ctt, IWBn*yl>»» 
^ 1 <DgB£*T fcflfJfc Loo»flstr*T-*-S. 

[0 0 7 6] -ir, S9ia^7 1 y7 , S4-cro^Jg'Ji^*, Mr 
Bn#y HilWil*itff*l*I«:«t»i-*»^ (YES 
<D£#) Ictt. ^fy^S 2 0lCit//T-^$tbfcittT 
*^©Ht#ifeBO^r»S:<8*Pi-5fc»lc> Milan #y 

MMMft 1 *ittf 3ErKdWfc«r»T Lfc^fcWM"*-*. 

[0 0 7 7] tfflB^y^S 2 O^O^JS'JII**, nstfy 

h»BSJ«l*sjflfT*l6jte»«r»TU-Cv^v^«^ (NO 

ft. MUBXT'yT'S 1 8&tA/-?B#y hAMtttltfS 

U$9®^S2 0-Co^y MKBSttt 1 «>jfe»«rW*p-i-6. 
[0 0 7 8] tWB*^y^S2 0-C©*WJ*S*. 



HUB* aRy HSBS*« 1 *Jifif*rtl<B*«rl»T 
(YE SOt t) Icfci. «5&£ftfc«*T#fal-#*El-5 
B t (DfiB8g§fBG d&i^ffSE n # y 

try— >a >-feV1J-3»4n#y h«IMIl«>MH"«tt 

TWlBIIUgjBG &Jg*P UT«WBMW#« 2 0 jc 
5. 

[0079] bfc*5oT, ^fs/^s 2 2-ei*MHE*tr 

min (B*ft®gttott9U:J:.&ft/NSB) 
fcS^SrWS'J LT, HHH^SiGtffc/hEfcy*-* «fc 9 * 
<D#£- (YESffltt) *^y:/S2 3fcJt^ 

Miia* try— a >~t vf - 3 k i «j * axfcatPimPi 

G MMiP¥JB! 2 0 |C fe g> C ft K£ $ ftT V > 5 S*EfS 
f-Kmax t*try— J/3 V-feV-9-©@te"rSSrft 

[0080] Mria^X y T'S 2 3 •CO^JBiJi^*. «fH2ftI 

-mwt.2 0 ^jgij^^fcsniEiSG^s^Efst^-^ «t 

9/h-C*v>^ (NO<D*#) ictt, MlSSosPy 
t8Hm^B^e3S<llt*t^fi8-eft5fcft, *xy 
/S2 4 -^SiJ^#m 2 0W fy— i V a >-fc V-^ 3 £0 
fe^-flc, fi|$!feB?r4S»-r5fcft»S»^lftffiTS:y 

yr$-frfc«, Milan jj? s/ hm&miimmten&i&v 

[008 1] MH2^X y/S 2 3 "CcDWgiJii&S^ tfFlESJ 

»#»2 0 ?m\ztitzmm&mG&Mi*®my r -? «t 

U/h-e/iV^' (YES<Dtf) Ktiu MllBaxKy hjf 
^«im$eiBlCjfiV^lit?fc5fcft^7 i y7'S 2 5 
BdV-rxtciStw-cfoS frfrtUBW- 5 1t 
fttr x MHE»Jffll^S2 O^fy^ ^-^^S)^6 

[0 0 8 2] UfcdSoT. MJlS^xyT"^^— 

a 6 4-ett.MW^m2 od»e>u*$^5*J««-§-* s A* 
^e-y— >a v-fev^3?r^ft*[Riici 8 o° mm 

jg|Jil8 0 o Els$*ooMl*S:iimu Mlfe^ 

Milan d?y h»K?SH^ffijfefT^tt5J:p^ 
1-5. 

[0 0 8 3] MJie^7 1 y7'S 2 2 T?0*J65ffe*, 

Wl&mm^&c 2 0 -^^JSU $ *vfc8B3E8SG dsS/J^Emf* 
— ^ i»3^:-e*v^^- (NOOt#) (Ctt. MlfBnjpy 

HJS68e^ 1 ©Ml^lc^^Bjas^maLfc^flg-CfcS 
fcft, 7fy^S2 6 t?MJlB0JSl#e 2 014* tf 

[0 0 8 4] Milan # v MtftflU tffffc&jfe 
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fr«ffi*»1-fc»©**jfi«Btfc:ft 3 1 . * try-f 

fc«0&BKn*y MMMIltBvvC. W3(feB£$ 
<arf5fcft©ll»iaeiMlTSr^yT**r«»6, n#y 

loo 8 5] roi^ic ttGB&ttm&ottllEltG 

«fc 0 Mfp?ft 2 0t«n*y Mf R$MI 1 frWfP LTWB 
jfefi^TTSfc, Xfy7'S2 7 T?ttlWB* *y-S/ 
a^tyf 3 ©ffig^&fclfc'ttifttinStt, ^xy^S 
2 8 fcitA/ClMBtfll $ ftfc* try-3/ 3 V-tr ^ 3 © 

1 8 o° -e*>5avSrWtt-5. 

[008 6] «rl2^xy^S 2 8-COW»J»*, imbm 
®#©2 ox-Wi^fitcitmn^ l 8 o° T-fcw!§£- 

(NO©£#) Kf4, 1 8{CitA/-e;*yyy 

S 1 8^T©S)^^aSb-CfTV\ flflMAiP 1 8 0° 
<OW& (YE Sit) fctt, X?rf$ 2 9JCitA/-e*9 

[0 0 8 7] MTIBxyyT'S 2 9-C©WJiem. o#y 
MHS«ltfKim*fflKft>S«& (YES©tt) 

<^#£- (NO©if) fctt, XT-yZfS 3 ltei§A/T?n 
#y hJtlfc«l *WWMrKNc01E**S. 
[0 0 8 8] flfffiotfy h»ffetBlS:Sl$W-*fett«f«- 
^lR]{CtiIte$-t-T^?>, 3 2-CI4djJ?s/ hjf 

[0 0 8 9] IWB*yy:/S 3 2"<WWJM8*» n#y 
hSRlMltimitilnAllCfcSItt- (YES©t#) Id 
It, y ^ S 3 3 (C^-CffiGtMPftit 2 0 Ttt* H 
y-i ^ a >"tr Vf - 3 ©tfcS3 « t Mtgtt B SrJgfcf 5 fc 

1 8fc*»UT*yy?"S 1 8ttTO»fP*»iELfT 
5. 

[0090] irie^x y ys 3 2 -e©*j»jif^*, 

n#y HIHWil#KI*tt*KdKV^*V^ (NO©£ 
|E|§#lB«rig*i-tSfc»©J^»^ffiT?:^ y T$-frT 

a>e>, $ne*ryys 1 scgiLtxfyys 1 sjy. 

[0 0 9 1] *»WfcJ:iitf. n#y h«Nta#«iBd» 

TIC, *ffilcfBo"Ca*«jSi*'CjE»K*tfC#«SMI 

£©»£&©©§£ J; 9 Bfifficutfy hftNttt«>&ff*ifti 
£&&£-£T, g^©s?^©ffim^*fT3ffl^»oE 

[0 0 9 2] 



«8*n*a«:i 9 n# y hJM^<o«ffijfef?i*K:*fcry 
*fftt««!to^aHt, * try-fa vfcvf-*s.fctWMF 

[0 0 9 3] a8»$iifcl!IIB!gK*i«t^tT««fc < t5 
£T7MfP¥fttt. fe*W»^»©^*SSItL-cmEn^ 
y h«MIMIiBicfioT]Ettttaifr£^i-« J: 

AffflAlC «t 9 fc&«S)^te©^ £f3& LTBtlfSn # y 
h»8Mii»]EJirWi*»6jfcJK*1"KltiiiKJBoTB** 

[0 0 9 4] flf2*9JH:> «TS2n#y h»gfc«©Mffij£ 

frftfc^try-f 3 *fcj: ob**©*****!* 
B*feS-O0EIB«:flS*nU iFlBPt*^J©«i*P*s*l©l^ 
f y- f 3 vih}3.fclfi@ : £&-fe v-tHc: £ 9 

i 9 £*fi!l»^(i©^ £PS LTIWB n # y b *HM|# 

#y hmmimmii^<ofmmtisxxfimnm^x 
[ o o 9 5 ] m 3 mm miB»#i&«*o#©fc £ 9 w 

3^-fe>^©&eS&£fM»-f5©'e, 3*5/ 
©Sffi^fT^tcgr*»c#^TS|S|SP^©E«Jc: bjfeM^ 

*»ojE*ftitfT*iSi©C*Sr-Br«8lJ:-c 

[0 0 9 6] B4I8WI4, «&IE5fetT^«§SS^ai^S:tC «t »» 
$ *irfc«Bf «»&«>MdH EMI d atfMMktclEBfe 

»#©-C*fiJi)**i©^Sri8JDT3£ b*MlE.ft*-9 
&»tt*!llPT*©-C, njj?y h»K!«i6Jffiffid»e»©ltlB 
Ella J:tF*fMi*KJ: 9&&«»**o*fclWe# 
5. 

[0 0 9 7] ^5^Wtt, ttC«mMUI«R^«(CJ: 9 

$ixfcS2iK»y-i? d s £ 9/Kf S«#lCtt, t9E0J 
ffll#St?£«ii)*fi©^5riiJp-t-5 £ 3£fl£fr*-* 
^K»»-rs©-C, n^y M»8Ss»^2ffid»P,©KRS 

1 0 0 9 8 ] m 6 fmtt. m&iiknfti&&&¥mz& 9 
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*»&©ltlBEIt*sJ:tf3fefMI*KJ: Ofe*flltb*li©* 
[0 0 9 9] Sg7|S91f4, tte*f?WBMWsn**K*0 

itfjfeffAflEKJ: 9fe&fl]»;*jfl0>;*J 
[0 10 0] £83&93r4, mK*xy-*sa>± s s+ 

[0 10 1] 893§9!f4, HMEJB!*»te>#tt* irlEn 

[0ffi«>ffi¥fc&!P3] 

[01] ^flWO-WllflKJSft***®^**^-** 
[02] *»WO-HI6^J:5n3j?y hJ§l£&©fi!l»r 

[03] #*WO-IOS«llc-J:5i3#y hiMftttoMIP 
[04] *38W©Kl^Sr*i"7n— f-*— b"C*>£. 

[0 5] x&moWittz&Tyv-?-*- k-c&s. 

[06] *«WOlMP**i-7n-^-b"C*>*. 
[07] #JMi!©-IHM!fcJ:4n#y Mf*»©*f? 
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EM! ->d2 






da - {dl + d2 + d3) / 2 
A *= dl - d2 - d3 
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[D6] 
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